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INTRODUCTION 


• Flexibility is important for high speed, 
high precision operation of lightweight 
manipulators. 

• Accurate dynamic modeling of flexible 
robot arms is needed. Previous work has mostly 
been based on linear elasticity with prescribed 
rigid body motions (i.e., no effect of flexible 
motion on rigid body motion). 

• Little or no experimental validation of 
dynamic models for flexible arms is available. 
Experimental results are also limited for 
flexible arm control. 

• We include the effects of prismatic as 
well as revolute joints. 

• We investigate the effect of full coupling 
between the rigid and flexible motions, and of 
axial shortening. 

• We also consider the control of flexible 
arms using only additional sensors. 


BACKGROUND 

Research since 1970's 

(e.g., (Book, Maizzo-Neto, Whitney 75]) 

Modeling of flexible mechanisms and structures 
(e.g., Elasto-Kineto Dynamics, Floating 
Frames, 70's) 

Approaches to control 

Trajectory planning (Meckl, Seering 83,85] 

Open loop (none) 

Closed loop with micromanipulator 
(Cannon et al, Book et al] 

Closed loop with additional sensors only (none) 

Experimental work 

[Zalucky and Hardt 84] 

[Cannon et al 83, 84] 

Theoretical control studies 

[Book et al, Cannon et al, etc, early 1 980's] 
Various control strategies proposed typically 
assuming all states available, no spillover, simple 
models, no implementation considerations. 


7 47 



MODELING AND SIMULATION OF FLEXIBLE 
ROBOTS WITH PRISMATIC JOINTS 

• Robots with both rigid and flexible links 
attached with revolute and/or prismatic joints 
can be modeled and analyzed. 

• The equations of motion are derived using 
Lagrange's equations. The prescribed motion, 
and prescribed torque/force cases can both be 
handled. 

• Flexible elements are represented as 
Euler-Bernoulli beams, and the axial shortening 
effect is also included. 

• Finite element analysis is used for the 
discretization of the resulting hybrid equations 
of motion. 

• Constraints are handled using Lagrange 
multipliers. 

• The resulting algebraic-differential 
equations are solved numerically using 
constraint stabilization methods. 
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Bi Nominal configuration 
I Actual configuration 







Schematic of a two-link robot. 
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link i-1 



Schematic of prismatic joint i. 



Schematic of prismatic joint i. 
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Time (sec.) 


Tip displacement in "fast pull" case with 
Ci = 0.025 m, C 2 = -0.7 m and T = 0.7 sec. 
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LABORATORY ROBOT 

Small table top spherical coordinate robot with 3 DOF 

Designed and built at UM 

Interlaced to an IBM PC/XT 

Convienent test bed experimental research work 

r and 0 axes are dc motor driven through ieadscrews 

+ axis is dc motor driven driven through a gear train 

all axes have tachometers and optical incremental 
encoders with counter circuits 

last link is intentionally designed to be flexible 

accelerometers (in two orthogonal directions) 
measure end of arm accelerations which are 
integrated to get velocities and positions 


7f4 


Lead Screw 



Schematic of the experimental setup. 
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Elastic lip displacement (m.) 



The elastic tip displacement obtained from the equations of motion 
with prescribed motions. 
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Elastic tip displacement obtained from the equations of motion 
with prescribed torque/force. 
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velocity (m./s.) 



Tune (sec.) 

Angular velocity of the first joint of the rigid manipulator 
with controller. 



Translational velocity of the third joint of the rigid manipulator 
with controller. 
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1 » 1 1 1 ■ 1 » 1 1 1 I I I I I I 

0 .5 1 1.5 2 2.5 3 3.5 4 

Time (sec.) 


Angular velocity of the first joint of the flexible manipulator 
with controller. 



Time (sec.) 

Translational velocity of the third joint of the flexible manipulator 
with controller. 
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Elastic tip displacement (m.) Elastic tip displacement (m.) 



0 .2 .4 .6 .8 1 1.2 1.4 1.6 1.8 2 

Time (sec.) 


Elastic tip displacement in the case with T = 1 sec. 
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SUMMARY AND CONCLUSIONS 


■ A general modeling procedure for robot 
arms consis ting of rigid and flexible links 
connected by revolute and/or prismatic joints 
has been developed and experimentally 
validated. 

• The significance of full coupling (effect 
of flexible motion on rigid body motion) has 
been demonstrated. 

a The axial shortening effect is shown to be 
significant for high speed operation of 
lightweight manipulators. 
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CONTROL OF A LEADSCREW DRIVEN FLEXIBLE 

ROBOT ARM 


• The laboratory robot is used to compare 
the performance of a rigid body motion 
controller with that of a rigid and flexible 
motion controller. 

• The rigid body motion controller uses 
only the joint motion measurements and joint 
actuators. The rigid and flexible motion 
controller also uses the end of arm motion 
measurements, but no additional actuators. 

• The leadscrev transmission 
characteristics as veil as observation and 
control spillover are considered. 

• The numerical and experimental results 
show good agreement, and indicate that 
significant reductions in arm vibration are 
possible through use of the rigid and flexible 
motion controller. 
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o 

K k 

Arm geometry and coordinates. 
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PHYSICAL CONSTRAINTS 


The physical constraints that are considered in this 
work are the ones imposed by the leadscrews only. 

. Condition for self locking assumption to be valid 
is: 

\i > tanfy) 

where 

jl is the thread coefficient of friction. 

Y, is the thread helix angle. 

. Effect of the self locking condition. 

. Effect of coulomb friction. 
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CONTROLLER DESIGN 


Equations of motion: 

jr + E (Z ,£) - E (t) 

2 = £ r t & > ^ i $/» > > ? 2 * 7 

J T =C' r t , t , 7 

Linearized equations: 

y « 4 y + Q u 

ir*lh r s* r 1\ a* & 

<£* r * £Sr , £ 4 > 1 

Integral plus state feedback controller: 

yff=jf <>-*<>«# ; y n = fcy,-R x )dt ; 
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Block diagram of the integral plus state feedback controller. 
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Figure 3. Flexible motion coordinate, q 1 1 (t), In response to 

the rigid and flexible motion controller In the 
reduced order model case. 
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Figure 4. Flexible motion coordinate, q 2 -|(t), In response to 

the rigid and flexible motion controller In the 
reduced order model case. 
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TVn^ f 

Figure 5. Flexible motion coordinate, q-j-jft), In response to 

the rigid and flexible motion controller In the 
control spillover case. 
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Figure 6. Flexible motion coordinate, q 12 <t), In response to 
the rigid and flexible motion controller In the 
control spillover case. 
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Figure 7. Flexible motion coordinate, q^ 2 <*). in response to 

the rigid and flexible motion controller In the 
control and observation spillover case. 
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Figure 8. 


Flexible motion coordinate, q-^O), ,n response to 

the rigid and flexible motion controller In the 
control and observation spillover with structural 
damping included. 
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Standard Set of Physical System 
Parameters 


VALUE 




Mass of the first beam (m ,) 

0.454 Kg 

Mass of the second beam (m 5 ) 

0.816 Kg 

Mass of the Payload (m f ) 

Cross sectional area of the second 

0.07 Kg 

beam (A 2 ) 

0.000151 m 2 

Length of the first beam ( L ,) 

0.233 m 

Length of the second beam (L 2 ) 

2 ra 

Gravitational acceleration (g ) 

9.81 m/#ec s 

Aluminum density (p) 

2707 Kj/m J 

Flexural rigidity (El) 

770.87 Pa 

Reference position for r 

1.85 m 

Reference position for 0 

0 rad 

Reference position for d 

0 rad 

Desired reference position for r 

2m 

Desired reference position for 0 

0.5 rad 

Desired reference position for d 

0.5 rad 

Senro natural frequency for r (u„ ) 

. 4 rad/sec 

Servo natnral frequency for # (w, <) 

4 rad/»ec 

Servo natnral frequency for d (w, ,) 

8 rad/sec 

Flexible motion gain, K ft 

•0.000178 

Flexible motion gain, K a 

•0.084 

Flexible motion gain, K 

1.568 


TABLE 1 



settling time 
(seconds) 

maximum deflection 
(peak to peak) 

rigid body controller 

11.0 

7.5mm 

rigid and flexible 
motion controller 

3.0 

2.7mm 


Table 2. 
110 
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Figure 10. • rospoqs* obtained from the rigid body controller In 

the experimental work. 


UH -m - - 1 - . .. 

*\V €M|MDWIWV 

(mm) 


24.00 


TVml I jMOOOl 

Figure 11. Total vertical deflection In response to the rigid 
body controller In the experimental work. 
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• rotation 
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Figure 12. • response obtained from the rigid and flexible 

motion controller In the experimental work. 
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Figure 13. Control signal for the second Joint obtained from the 
rigid and flexible motion controller In the 
experimental work. 
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Figure 14. 


ORIGINAL PAGE IS 
OF POOR QUALITY 



Qnaj (mod 

Total vortical dofloctlon In rosponsa to tho rigid and 
flexible motion controller In the experimental work. 
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RIGID BODY CONTROLLER VERSUS 
RIGID AND FLEXIBLE MOTION CONTROLLER 

Simulation results: 

* Control spillover effect can be observed, but 
does not cause significant deterioration. 

* Control and observation spillover can 
destabilize the residual mode. However, a 
small amount of damping (0.01 45) eliminates 
the problem. 

* Settling time is reduced from 3.5 to 1 .07 
seconds, and maximum vibration amplitude is 
reduced by 50%. 


Experimental results: 

* With low pass filtering and light structural 
damping, no detrimental spillover effects were 
observed. 

* Settling time is reduced from 1 1 to 3 
seconds, and maximum vibration amplitude is 
reduced by 75%. 
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SUMMARY AND CONCLUSIONS 


A dynamic model of a spherical coordinate robot arm, 
whose last link is flexible, is developed. The 
constraints imposed by the leadscrew transmission 
mechanisms are also considered. 

The interrelationships between the robot arm 
structural flexibility and the controller design 
are investigated using a rigid body controller. 

The rigid and flexible motion controller, which employs 
additional sensors only, has led to an approximate 50% 
reduction in the magnitude of the flexible motion even 
in the presence of the observation and control 
spillover. 

The experimental results of the rigid and flexible 
motion controller show good agreement with those 
of the digital simulation. 


SUMMARY AND CONCLUSIONS 

• A general model ing method for robot arms 
with flexible and rigid links connected by 
prosmatic and revolute joints has been 
presented and experimentally validated. 

• A flexible arm controller which uses end 
of arm motion meaurements, but only joint 
actuators has been numerically and 
experimentally studied and found to give good 
rigid body control with significant reduction in 
end of arm vibrations. 
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